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© Verfahren und Vorrichtung zur Regelung der Vorhalteposition eines Manipulators eines Handhabungsgerats 



Die Erfindung betrifft ein Verfahren zur Regelung der 
Vorhalteposition eines in mehreren Freiheitsgraden be- 
wegbaren Manipulators (2) eines Handhabungsgerats (1) 
relativ zu einem Objekt (3) entlang einer Verfahrbahn. Urn 
eine schnellere Regelung der Vorhalteposition zu ermog- 
lichen, wird vorgeschlagen, dass mehrere Punkte zumin- 
dest eines Teils der Ist- Verfahrbahn gespeichert sind und 
fur eine vorausschauende Regelung der Vorhalteposition 
des Manipulators (2) entlang dieses Teils der Verfahrbahn 
herangezogen werden. 
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Beschreibung 

Die vorliegende Erfindung betrifft ein Verfahren und eine 
Vorrichtung zur Regelung der Vorhalteposition eines in 
mehreren Freiheilsgraden bewegbaren Manipulators eines 5 
Handhabungsgerats relativ zu einem Objekt entlang einer 
Verfahrbahn. Die Erfindung betrifft auBerdem ein Handha- 
bungsgerat mit einem in mehreren Freiheitsgraden beweg- 
baren Manipulator, dessen Vorhalteposition relativ zu einem 
Objekt regelbar ist. 10 

Das Handhabungsgerat ist bspw. als ein mehrgelenkiger 
Industrie-Roboter ausgebildet. Derartige Industrie-Roboter 
werden insbesondere in der Automobilindustrie in derFerti- 
gung und der Qualitatssicherung eingesetzt. Fur die unter- 
schiedlichen Einsatzmoglichkeiten eines Industrie-Roboters 15 
kann der Manipulator beliebig ausgebildet sein. 

Der Manipulator ist bspw. als ein Werkzeug, insbesondere 
als ein SchweiBgerat, als ein Gerat zum Auftragen von 
KlebstorT, von Farbe oder von anderen Beschichtungen auf 
eine Oberflache, als ein Bearbeitungsgerat o. a. ausgebildet. 20 
Zum Ergreifen eines oder mehrerer Objekte kann der Mani- 
pulator als ein Greifer, ein Saugnapf o. a. ausgebildet sein. 
SchlieBlich ist es denkbar, dass der Manipulator als ein 
Messkopf z. B. zum Messen des Oberflachenverlaufs eines 
Objekts, einer Spaltbreite, eines Spaltversatzes, einer 25 
Schichtdicke o. a. ausgebildet ist. 

Damit der Manipulator die ihm zugedachte Aufgabe er- 
fullen kann, muss er in eine definierte Vorhalteposition rela- 
tiv zu einem Objekt gebracht werden. Unter dem Begriff 
Vorhalteposition wird gemaB dem vorliegenden Patent so- 30 
wohl die Positionierung als auch die Ausrichtung des Mani- 
pulators relativ zu dem Objekt verstanden. 

Aus dem Stand der Technik sind Handhabungsgerate be- 
kannt, die eine interne Steuerungseinrichtung aufweisen. 
Auf der Steuerungseinrichtung ist ein Steuerungsprogramm 35 
lauffahig, durch das der Manipulator entlang einer program- 
mierten Verfahrbahn in die Vorhalteposition bewegt werden 
kann. Wenn das Objekt stets an derselben Position angeord- 
net ist, reicht eine solche Steuerung der Verfahrbahn bis zur 
Vorhalteposition vollkommen aus. Falls die Position des 40 
Objekts jedoch gewissen Schwankungen unterworfen ist, 
was der Regelfall ist, kann durch eine Steuerung alleine 
nicht mehr sichergestellt werden, dass eine bestimmte Vor- 
halteposition des Manipulators relativ zu dem Objekt stets 
mit der erforderlichen Genauigkeit eingenommen wird. 45 
Schwankungen der Position des Objekts konnen vielerlei 
Ursachen haben. 

Urn sicherzustellen, dass die Vorhalteposition des Mani- 
pulators relativ zu dem Objekt auch bei Schwankungen der 
Position des Objekts stets mit der geforderten Genauigkeit 50 
eingenommen wird, ist es aus dem Stand der Technik eben- 
falls bekannt, die Vorhalteposition des Manipulators relativ 
zu dem Objekt zu regeln. Aus dem Stand der Technik sind 
unterschiedliche Verfahren zur Regelung der Vorhaltepos- 
ition des Manipulators bekannt. Diese bekannten Verfahren 55 
zur Regelung der Vorhalteposition sind jedoch sehr kompli- 
ziert und langsam. 

Im Rahmen der Regelung der Vorhalteposition des Mani- 
pulators relativ zu einem Objekt wird die Ist- Vorhaltepos- 
ition des Manipulators zunachst mittels Sensoren erfasst und 60 
dann auf eine Soli- Vorhalteposition geregelt. Die Sensoren 
sind bspw. als optische oder als taktile Sensoren ausgebildet. 

Insbesondere sind sie als Laser-Sensoren zum Messen 
von Abstanden, als Kraft/Momenten-Sensoren zum Messen 
von Kraften bzw. Momenten oder als Beruhrungssensoren 65 
zur Detektion einer Beruhrung mit dem Objekt ausgebildet. 

Die Sensoren sind in einem bestimmten Bezug (Position 
und Ausrichtung) zu dem Manipulator angeordnet. Vor der 
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Regelung der Vorhalteposition miissen die Sensoren in ei- 
nen konkreten Bezug zu dem Manipulator und zu dem Ob- 
jekt gebracht werden (Einrichten) und die Parameter der Re- 
gelung an den konkreten Bezug angepasst werden (Kalibrie- 
ren). Der Bezug der Sensoren zu dem Manipulator kann sich 
aufgrund von Temperaturschwankungen, mechanischen 
Einwirkungen auf die Sensoren oder den Manipulator, o. a. 
verandern, wodurch ein emeutes Kalibrieren und u. U. sogar 
eine emeutes Einrichten der Vorrichtung zur Durchfuhrung 
der Regelung notwendig wird, Wahrend des Einrichtens und 
Kalibrierens steht die Vorrichtung nicht fur eine Regelung 
zur Verfugung, die Regelung der Vorhalteposition muss un- 
terbrochen werden. 

Samtliche bekannten Verfahren zur Regelung der Vorhalt- 
eposition des Manipulators haben auBerdem den Nachteil, 
dass die Verfahrgeschwindigkeit des Manipulators relativ 
klein ist, da die Regelung in Unkenntnis der bevorstehen- 
den, zu regelnden Verfahrbahn des Manipulators erfolgt. 
Deshalb muss die Verfahrgeschwindigkeit so klein gewahlt 
werden, dass auch im Extremfall einer Verfahrrichtungsum- 
kehr eine rasche und genau Positionierung des Manipulators 
sichergestellt werden kann, Bei einer zu hohen Verfahrge- 
schwindigkeit wurde der Manipulator bei stark gekrummten 
Verfahrbahnen oder einer Verfahrrichtungsumkehr aufgrund 
der Massentragheit uber die geregelte Verfahrbahn hinaus- 
schieBen und somit die geregelte Verfahrbahn verlassen. 

Es ist deshalb eine Aufgabe der vorliegenden Erfindung, 
ein Verfahren der eingangs genannten Art dahingehend aus- 
zugestalten und weiterzubilden, dass eine moglichst 
schnelle Regelung der Vorhalteposition erreicht und dass 
insbesondere hohere Verfahrgeschwindigkeiten des Mani- 
pulators auf der Verfahrbahn realisiert werden konnen, ohne 
dass es zu einem Verlust an Regelungsgenauigkeit kommt, 

Zur Losung dieser Aufgabe schlagt die Erfindung ausge- 
hend von dem Verfahren der eingangs genannten Art vor, 
dass mehrere Punkte zumindest eines Teils der Ist- Verfahr- 
bahn gespeichert sind und fur eine vorausschauende Rege- 
lung der Vorhalteposition des Manipulators entlang dieses 
Teils der Verfahrbahn herangezogen werden, 

ErfindungsgemaB ist erkannt worden, dass die Regelung 
der Vorhalteposition durch eine vorausschauende Regelung 
auf einfache Weise entscheidend beschleunigt werden kann. 
Wahrend der vorausschauenden Regelung der Vorhaltepos- 
ition wird der bevorstehende Verlauf der Verfahrbahn be- 
rticksichtigt. Wenn der bevorstehende Verlauf der Verfahr- 
bahn es zulasst, bspw. bei einer geraden oder einer nur ge- 
ringfugig gekrummten Verfahrbahn, kann die Verfahrge- 
schwindigkeit des Manipulators hoch gewahlt werden. Da- 
durch kann die Regelung der Vorhalteposition entlang einer 
Verfahrbahn entscheidend beschleunigt werden. Bei zuneh- 
mender Krummung der bevorstehenden Verfahrbahn muss 
die Verfahrgeschwindigkeit zunehmend reduziert werden. 
Durch die Wahl einer geringen Verfahrgeschwindigkeit bei 
starken Kriimmungen der bevorstehenden Verfahrbahn kann 
zudem die Genauigkeit der Regelung der Vorhalteposition 
des Manipulators entlang der Verfahrbahn entscheidend er- 
hoht werden. Bei dem erfindungsgemaBen Verfahren kann 
die Verfahrgeschwindigkeit somit dem Verlauf der bevorste- 
henden Verfahrbahn individuell angepasst werden. 

Die Punkte der Ist- Verfahrbahn konnen auf unterschiedli- 
che Weise, z, B. empirisch, simulativ oder durch Berech- 
nung, bestimmt werden. Bei der empirischen Bestimmung 
der Punkte der Ist- Verfahrbahn konnen die einzelnen Punkte 
entweder mit dem Manipulator des Handhabungsgerats ma- 
nuell oder von einer ersten Steuereinrichtung gesteuert an- 
gefahren werden. Bei der simulativen Besummung der 
Punkte wird zunachst ein Modell des Handhabungsgerats 
und des Objekts, vorzugs weise auf einem Computer, er- 
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stellt, Anhand dieses Modells wird dann durch Simulation 
der Verfahrbahn die Ist-Verfahrbahn bestimmt. Bei der ma- 
thematischen Berechnung der Punkte der Ist-Verfahrbahn 
wird zunachst ein mathematisches Modell des Handha- 
bungsgerats und des Objekts erstellt, und die Punkte werden 
dann durch Losen mathematischer Gleichungen berechnet. 

GemaB einer vorteilhaften Weiterbildung der vorliegen- 
den Erfindung wird vorgeschlagen, dass die Ist-Verfahrbahn 
des Manipulators vor der Regelung der Vorhalteposition ab- 
gefahren wird und dabei die Punkte zumindest eines Teils 
der Ist-Verfahrbahn aufgenommen und abgespeichert wer- 
den. Die Ist-Verfahrbahn muss nicht mit besonders hohen 
Anforderungen an die Genauigkeit abgefahren werden, da 
die Verfahrbahn im Rahmen der nachfolgenden Regelung 
der Verfahrbahn des Manipulators korrigiert werden kann. 
Die abgefahrene Ist-Verfahrbahn stellt lediglich eine Ab- 
schatzung des Verlaufs der Soil- Verfahrbahn dar und muss 
so genau sein, dass sie fur eine vorausschauende Regelung 
der Vorhalteposition des Manipulators entlang der Verfahr- 
bahn herangezogen werden kann. 

Die Ist-Verfahrbahn wird vorteilh after weise von dem Ma- 
nipulator vor der Regelung der Vorhalteposition von einer 
internen Steuerungseinrichtung des Handhabungsgerats ge- 
steuert abgefahren. Auf der intemen Steuerungseinrichtung 
lauft ein Steuerungsprogramm ab, in dem die einzelnen 
Punkte der Ist-Verfahrbahn programmiert sind. Das Steue- 
rungsprogramm steuert das Handhabungsgerat derart an, 
dass der Manipulator wahrend des Ablaufs des Steuerungs- 
programms die Ist-Verfahrbahn abfahrt. Dabei werden die 
Punkte zumindest eines Teils der Ist-Verfahrbahn aufge- 
nommen und abgespeichert. AuBer den in dem Steuerungs- 
programm programmierten Punkten der Ist-Verfahrbahn 
konnen noch zusatzliche Punkte der Ist-Verfahrbahn aufge- 
nommen und gespeichert werden. 

Die Punkte zumindest eines Teils der Ist-Verfahrbahn 
werden vorzugsweise von einer externen Regelungseinrich- 
tung aufgenommen und abgespeichert. Auf der externen Re- 
gelungseinrichtung lauft ein Regelungsprogramm ab, das 
die Vorhalteposition des Manipulators auf der Verfahrbahn 
regelt. Die externe Regelungseinrichtung ist bspw. als ein 
Personal Computer (PC) oder als ein Industrie-PC ausgebil- 
det. Das Regelungsprogramm kann in einer Standard-Pro- 
grammiersprache programmiert und ohne groBen Aufwand 
umprogrammiert werden. In einem bestimmten Modus (Re- 
cord-Mode) vor der Regelung der Vorhalteposition kann das 
Regelungsprogramm auch die Punkte der von dem Manipu- 
lator abgefahrenen Ist-Verfahrbahn aufnehmen und abspei- 
chern. Die gespeicherten Punkte werden dann in einem an- 
deren Modus (Operation-Mode) fur die vorausschauende 
Regelung der Vorhalteposition herangezogen. 

GemaB einer anderen vorteilhaften Weiterbildung der 
vorliegenden Erfindung wird vorgeschlagen, dass die ex- 
terne Regelungseinrichtung von der internen Steuerungsein- 
richtung aufgerufen wird. Das Steuerungsprogramm der in- 
ternen Steuerungseinrichtung ist ublicherweise in einer pro- 
prietaren, nur auf der Steuerungseinrichtung eines bestimm- 
ten Handhabungsgerats lauffahigen Programmierungsspra- 
che programmiert. Es ware nur mit einem groBen Aufwand 
moglich, das gesamte Regelungsprogramm in das Steue- 
rungsprogramm zu integrieren. Deshalb sind in dem Steue- 
rungsprogramm bestimmte Program mierbefehle (Aufrufbe- 
fehle, Ruckholbefehle) vorgesehen, urn das Regelungspro- 
gramm der externen Regelungseinrichtung von dem Steue- 
rungsprogramm aus aufzurufen. Das Einfugen dieser Pro- 
grammierbefehle in das Steuerungsprogramm ist mit einem 
geringen Aufwand moglich. Je nach dem in welchem Mo- 
dus die Regelung betrieben wird, werden durch einen Auf- 
ruf des Regelungsprogramms der Regelungseinrichtung die 



Punkte der Ist-Verfahrbahn aufgenommen und gespeichert 
(Record-Mode) oder die Vorhalteposition vorausschauend 
geregelt (Operation-Mode). 
In einer anderen vorteilhaften Weiterbildung der Erfin- 

5 dung wird vorgeschlagen, dass vor der Regelung der Vor- 
halteposition die Soil- Vorhalteposition des Manipulators an- 
gefahren wird, wahrend einer Veranderung der Soli- Vorhalt- 
eposition um jeweils einen Freiheitsgrad Messdaten, durch 
die die Vorhalteposition des Manipulators charakterisiert ist, 

10 aufgenommen und gespeichert werden und die Regelung 
der Vorhalteposition in Abhangigkeit von den Messdaten 
durchgefuhrt wird. Zwischen den aufgenommenen Messda- 
ten und der Position des Manipulators besteht ein Zusam- 
menhang. Somit sind in den aufgenommenen Messdaten In- 

15 formationen iiber die Position des Manipulators enthalten. 
Die Soil- Vorhalteposition wird in einem weiteren Modus 
(Parameter-Mode) vor der Regelung der Vorhalteposition 
angefahren. Zum Anfahren der Soil- Vorhalteposition im Pa- 
rameter-Mode werden die im Record-Mode gespeicherten 

20 Punkte der Ist-Verfahrbahn herangezogen. Sobald die Soll- 
Vorhalteposition erreicht ist, beginnt eine Trainingsphase, in 
der fur die spatere, im Rahmen des Operation-Mode durch- 
gefuhrte Regelung der Vorhalteposition benotigte Informa- 
tionen ermittelt werden. 

25 Wahrend der Trainingsphase wird der Manipulator um 
die Soli- Vorhalteposition um jeweils einen Freiheitsgrad in 
unterschiedliche Vorhaltepositionen relativ zu dem Objekt 
bewegt. Der Manipulator wird um jeden Freiheitsgrad in 
Vorhaltepositionen bewegt, die vorzugsweise zu beiden Sei- 

30 ten der Soll-Vorhalteposition liegen. Die Vorhaltepositionen 
des Manipulators werden durch Sensoren ermittelt, die vor- 
zugsweise an dem Manipulator befestigt sind. Die Sensoren 
liefern Messdaten anhand derer eine Vorhalteposition des 
Manipulators charakterisiert ist. Die Messdaten sind bspw. 

35 die Abstande von den Sensoren zu dem Objekt, Krafte oder 
Momente, die von dem Objekt auf die Sensoren einwirken. 
Die Messdaten konnen auch Bildmessdaten sein. Bildmess- 
daten werden durch Vermessen von Bildem gewonnen, die 
von einer CCD-Kamera o. a. aufgenommen wurden, Im 

40 Rahmen der Trainingsphase werden die Messdaten fur jeden 
der Freiheitsgrade fur jede der Vorhaltepositionen aufge- 
nommen. Es ist denkbar, dass die gespeicherten Messdaten 
fur die Regelung der Vorhalteposition weiterverarbeitet wer- 
den. Dann ist die Trainingsphase fur diese Soll-Vorhaltepos- 

45 ition abgeschlossen. Der Manipulator kann eine weitere 
Soll-Vorhalteposition anfahren und fur diese Soll-Vorhalt- 
eposition eine weitere Trainingsphase durchlaufen, bis alle 
Soli- Vorhaltepositionen angefahren worden sind. Dann ist 
der Parameter-Mode abgeschlossen. Die spatere, im Rah- 

50 men des Operation-Mode durchgefuhrte Regelung der Vor- 
halteposition wird in Abhangigkeit von den gespeicherten 
Messdaten durchgefuhrt. 

Bei dem erfindungsgemaBen Verfahren ersetzt die Trai- 
ningsphase das bei herkommlichen, aus dem Stand der 

55 Technik bekannten Verfahren zum Regeln der Vorhaltepos- 
ition des Manipulators eines Handhabungsgerats notwen- 
dige Einrichten (Positionierung der Sensoren relativ zu dem 
Objekt) und Kalibrieren (Einstellen der Parameter der Rege- 
lung). 

60 Auch bei diesem Verfahren, bei dem vor der Regelung der 
Vorhalteposition eine Trainingsphase durchlaufen wird, 
werden mehrere Punkte zumindest eines Teils der Ist-Ver- 
fahrbahn gespeichert und fur eine vorausschauende Rege- 
lung der Vorhalteposition des Manipulators entlang dieses 

65 Teils der Verfahrbahn herangezogen. Das Durchlaufen einer 
Trainingsphase vor der Regelung der Vorhalteposition hat 
die angegebenen Vorteile aber auch ohne diese Merkmale 
des Kennzeichens des Patentanspruchs 1. Der Schutz des 
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Patents soil sich deshalb auch auf ein Verfahren der zuletzt 
genannten Art beziehen, bei dem die im Kennzeichen des 
Patentanspruchs 1 genannten Merkmale fehlen. 

GemaB einer bevorzugten Ausfuhrungsform der vorlie- 
genden Erfindung wird vorgeschlagen, dass vor der Rege- 5 
lung der Vorhalteposition 

- die Soli- Vorhalteposition angefahren wird, 

- ein Soll-Messvektor mit den Messdaten aufgenorn- 
men wird, 10 

- fur jeden Freiheitsgrad der Manipulator des Handha- 
bungsgerats aus der Soli- Vorhalteposition heraus in 
mehrere Vorhaltepositionen bewegt und in jeder Vor- 
halteposition ein Messvektor aufgenomrnen wird, 

- fur jeden Freiheitsgrad fur dieselben Messdaten der 15 
Messvektoren der Betrag des Gradienten ermittelt und 

in einer Gradientenmatrix gespeichert wird, und im 
Rahmen der Regelung der Vorhalteposition 

- ein Korrekturvektor aus der Multiplikation des 
Kehrwerts der Gradientenmatrix mit der Differenz des 20 
S oil-Mess vektors und eines Ist-Messvektors in der 1st- 
Vorhalteposition des Manipulators oder anhand eines 
anderen geeigneten Verfahrens ermittelt wird und 

- die Vorhalteposition in Abhangigkeit von dem Kor- 
rekturvektor geregelt wird. 25 

GemaB dieser bevorzugten Ausfuhrungsform werden in 
der Trainingsphase im Parameter-Mode die fur die Soil- Vor- 
halteposition aufgenommenen Messdaten in einem Soil- 
Mess vek tor und die Messdaten, die fiir im Rahmen der Trai- 30 
ningsphase angefahrene Vorhaltepositionen aufgenomrnen 
wurden, in Messvektoren gespeichert. Fiir jeden Freiheits- 
grad, urn den der Manipulator bewegbar ist, werden also von 
der Soli- Vorhalteposition aus mehrere Vorhaltepositionen in 
jede Richtung angefahren und in jeder Vorhalteposition ein 35 
Messvektor aufgenomrnen. Die Dimension der Messvekto- 
ren entspricht der Anzahl der fur jede Vorhalteposition auf- 
genommenen Messdaten. Die Dimension ailer Messvekto- 
ren ist gleich groB. 

Fiir jeden Freiheitsgrad werden die Messvektoren und der 40 
Soll-Messvektor dann weiterverarbeitet. Aus denselben 
Messdaten der Messvektoren eines Freiheitsgrades wird der 
Betrag des Gradienten ermittelt und in einer Gradientenma- 
trix gespeichert. Die Gradientenmatrix hat somit die Dimen- 
sionen (Anzahl der fiir jede Vorhalteposition aufgenomme- 45 
nen Messdaten) x (Anzahl der Freiheitsgrade). Es ist denk- 
bar, den Kehrwert der Gradientenmatrix bereits in dem Pa- 
rameter-Mode zu berechnen und abzuspeichern. Vorzugs- 
weise wird er aber erst in dem nachfolgenden Operation- 
Mode berechnet. Damit ist die Trainingsphase fiir diese 50 
Soli- Vorhalteposition abgeschlossen, Die Gradientenmatrix 
kann auch als Jakobimatrix oder als Sensibilitatsmatrix be- 
zeichnet werden. 

Im Rahmen des Operation-Mode wird dann fur die Rege- 
lung der Vorhalteposition des Manipulators ein Ist-Mess- 55 
vektor ermittelt, d. h. es werden die Messdaten in der mo- 
men tanen Vorhalteposition des Manipulators des Handha- 
bungsgerats ermittelt und in dem Ist-Messvektor gespei- 
chert. Dann wird ein Differenzvektor aus der Differenz des 
Soll-Messvektors und des Ist-Messvektors gebildet. Des 60 
Weiteren wird der Kehrwert der Gradientenmatrix berechnet 
und wahlweise abgespeichert. 

SchlieBlich wird ein Korrekturvektor aus der Multiplika- 
tion des Kehrwerts der Gradientenmatrix mit dem Diffe- 
renzvektor berechnet und die Vorhalteposition in Abhangig- 65 
keit von dem Korrekturvektor geregelt. 

Der Korrekturvektor kann auch rnittels eines anderen ge- 
eigneten Verfahrens bestimmt werden, bspw. durch den Ein- 



satz eines sequentiellen Kalman filters. Derartige geeignete 
Verfahren zum Berechnen des Korrekturvektors sind aus 
dem Stand der Technik bekannt und konnen von einem 
Fachmann nach Belieben eingesetzt werden. Diese anderen 
geeigneten Verfahren haben den Vorteil, dass auf eine relativ 
aufwendige Bildung des Kehrwerts der Gradientenmatrix 
verzichtet werden kann. 

Wahrend des Operation-Mode fahrt der Manipulator zu- 
nachst die Verfahrbahn gemaB den wahrend des Record- 
Mode gespeicherten Punkten ab. Diese Verfahrbahn wird 
dann im Rahmen der Regelung der Vorhalteposition des Ma- 
nipulators mit Hilfe des Korrekturvektors korrigiert. Bei 
dem erfindungsgemaBen Verfahren wird die Vorhaltepos- 
ition also nicht absolut, sondern lediglich relativ zu einer 
Vorhalteposition auf der gespeicherten Verfahrbahn gere- 
gelt. 

Vorteilhafterweise wird die Ist- Vorhalteposition im Rah- 
men der Regelung der Vorhalteposition um einen Bruchteil 
des Korrekturvektors korrigiert und anschlieBend der Ist- 
Messvektor in der korrigierten Ist- Vorhalteposition und dar- 
aus der Korrekturvektor erneut ermittelt. Die Ist- Vorhalt- 
eposition wird also nicht um den gesamten Korrekturvektor 
korrigiert. Um ein Uberschwingen der Regelung zu verhin- 
dern, wird vielmehr versucht, sich der Soil- Vorhalteposition 
langsam von einer Richtung her anzunahern. Dadurch wird 
eine Regelung mit einem gedampften Einschwingverhalten 
realisiert. Durch eine geeignete Wahl des Bruchteils des 
Korrekturvektors kann die Dampfungskonstante der Rege- 
lung bestimmt werden. 

Die Regelung der Vorhalteposition wird vorzugsweise ab- 
gebrochen, wenn jedes der Elemente des Korrekturvektors 
kleiner als ein Abbruchkriterium ist. Durch eine geeignete 
Wahl des Abbruchkriteriums kann einerseits die Genauig- 
keit der Regelung und andererseits die Regelungsgeschwin- 
digkeit bestimmt werden. Je kleiner der Wert des Abbruch- 
kriteriums gewahlt wird, desto genauer kann die Regelung 
der Vorhalteposition durchgefiihrt werden. Ein kleiner Wert 
des Abbruchkriteriums bedeutet jedoch auch, dass die Rege- 
lung mehr Zeit benotigt, bis das Abbruchkriterium erfullt 
ist. 

Um eine Regelbarkeit der Vorhalteposition des Manipula- 
tors innerhalb eines bestimmten Arbeitsvolumens der Rege- 
lung sicherzustellen, sollten die aufgenommenen Messvek- 
toren nach Mbglichkeit das gesamte Arbeitsvolumen abdek- 
ken. Des Weiteren sollten fiir jeden Freiheitsgrad so viele 
Messvektoren aufgenomrnen werden, dass eine zuverlassige 
Berechnung des Betrags des Gradienten der Messdaten 
mbglich ist. Deshalb wird gemaB einer bevorzugten Ausfuh- 
rungsform der Erfindung vorgeschlagen, dass fiir jeden Frei- 
heitsgrad von der Soil- Vorhalteposition aus mindestens zwei 
Messvektoren in jede Richtung aufgenomrnen werden, Vor- 
teilhafterweise werden jedoch fiir jeden Freiheitsgrad von 
der Soli- Vorhalteposition aus funf Messvektoren in jede 
Richtung aufgenomrnen. Somit ergeben sich fiir jeden Frei- 
heitsgrad zehn Messvektoren und der Soll-Messvektor, also 
elf Messvektoren. Fur jedes der aufgenommenen und in den 
Messvektoren gespeicherte Messdatum wird dann der Be- 
trag des Gradienten berechnet und in der Gradientenmatrix 
abgespeichert. 

Die Messvektoren miissen zusammen fiir jeden Freiheits- 
grad, in dem die Vorhalteposition des Manipulators des 
Handhabungsgerats geregelt wird, mindestens ein unabhan- 
giges Messdatum enthalten. GemaB einer weiteren bevor- 
zugten Ausfuhrungsform der Erfindung wird vorgeschlagen, 
dass die Messvektoren zusammen mindestens sechs Mess- 
daten enthalten. Dadurch kann die Position und Ausrichtung 
des Manipulators relativ zu dem Objekt in sechs Freiheits- 
graden eindeutig charakterisiert werden. Damit kann die 
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Vorhalteposition des Manipulators um sechs Freiheitsgrade 
im dreidimensionalen Raum geregelt werden. Vorzugsweise 
enthalten die Messvektoren jeweils 32 Messdaten. 

Eine weitere Aufgabe der vorliegenden Erfindung besteht 
darin, eine Vorrichtung der eingangs genannten Art dahinge- 
hend auszugestalten und weiterzubilden, dass eine mog- 
lichst schnelle Regelung der Vorhalteposition erreicht und 
dass insbesondere hohere Verfahrgeschwindigkeiten des 
Manipulators auf der Verfahrbahn realisiert werden konnen, 
ohne dass es zu einem Verlust an Regelungsgenauigkeit 
kommt. 

Zur Losung dieser Aufgabe schlagt die Erfindung ausge- 
hend von der Vorrichtung der eingangs genannten Art vor, 
dass die Vorrichtung Mittel zur Durchfuhrung des Verfah- 
rens nach einem der Anspriiche 1 bis 13 aufweist. 

Eine weitere Aufgabe der vorliegenden Erfindung besteht 
schlieBlich darin, ein Handhabungsgerat der eingangs ge- 
nannten Art dahingehend auszugestalten und weiterzubil- 
den, dass eine moglichst schnelle Regelung der Vorhaltepos- 
ition erreicht und dass insbesondere hohere Verfahrge- 
schwindigkeiten des Manipulators auf der Verfahrbahn rea- 
lisiert werden konnen, ohne dass es zu einem Verlust an Re- 
gelungsgenauigkeit kommt. 

Zur Losung dieser Aufgabe schlagt die Erfindung ausge- 
hend von dern Handhabungsgerat der eingangs genannten 
Art vor, dass das Handhabungsgerat Mittel zur Durchfuh- 
rung des Verfahrens nach einem der Anspriiche 1 bis 13 auf- 
weist. 

Die erfindungsgemaBe Vorrichtung und das erfindungsge- 
maBe Handhabungsgerat weisen insbesondere Mittel auf, 
um in einem Record-Mode mehrere Punkte zumindest eines 
Teils der 1st- Verfahrbahn zu speichern und die gespeicherten 
Punkte dann in einem Operation-Mode flir eine voraus- 
schauende Regelung der Vorhalteposition des Manipulators 
entlang dieses Teils der Verfahrbahn heranzuziehen. Des 
Weiteren weisen die erfindungsgemaBe Vorrichtung und das 
erfindungsgemaBe Handhabungsgerat Mittel auf, um in ei- 
nem Parameter-Mode im Rahmen einer Trainingsphase den 
Manipulator in eine Soli- Vorhalteposition zu fahren, um den 
Manipulator um die einzelnen Freiheitsgrade des Handha- 
bungsgerats in andere Vorhaltepositionen zu verfahren und 
fur jeden Freiheitsgrad in jeder Vorhalteposition die Mess- 
daten aufzunehmen und zu speichern, durch die die entspre- 
chende Vorhalteposition charakterisiert ist. 

Bei der erfindungsgemaBen Vorrichtung und dem erfin- 
dungsgemaBen Handhabungsgerat kann die Verfahrge- 
schwindigkeit des Manipulators aufgrund der vorausschau- 
enden Regelung besonders groB gewahlt werden. AuBerdem 
ersetzt die Trainingsphase das Einrichten und Kalibrieren 
der Sensoren. Mit der erfindungsgemaBen Vorrichtung und 
dem erfindungsgemaBen Handhabungsgerat ist somit eine 
schnellere Regelung der Vorhalteposition mbglich, ohne 
dass es zu einem Verlust an Regelungsgenauigkeit kommt. 

GemaB einer vorteilhaften Weiterbildung der vorliegen- 
den Erfindung wird vorgeschlagen, dass an dem Manipula- 
tor des Handhabungsgerats zur Ermittlung der Ist- Vorhalt- 
eposition des Manipulators relativ zu dem Objekt minde- 
stens ein Sensor befestigt ist. 

Der oder jeder Sensor ist vorteilhafterweise derart relativ 
zu dem Objekt angeordnet, dass die Folge der Messdaten 
der fiir einen Freiheitsgrad aufgenommenen Messvektoren 
streng monoton ist. Dies ist eine wichtige Voraussetzung, 
um den Manipulator aus alien Positionen und Ausrichtun- 
gen relativ zu dem Objekt stets in die gewunschte Soli- Vor- 
halteposition regeln zu konnen. 

Des Weiteren muss die Beobachtbarkeit der Regelung si- 
chergestelit sein. Deshalb wird gemaB einer anderen vorteil- 
haften Ausfuhrungsform der Erfindung vorgeschlagen, dass 



der oder jeder Sensor derart relativ zu dem Objekt angeord- 
net ist, dass in der Gradienten matrix fur jeden Freiheitsgrad 
jeweils fur mindestens einen aufgenommenen Messdaten 
ein Gradienten-Betragswert enthalten ist. 

5 Damit die in der Gradientenmatrix im Rahmen der Rege- 
lung der Vorhalteposition auch verarbeitet werden konnen, 
und zu einem zuverlassigen Ergebnis fiihren, wird vorge- 
schlagen, dass der oder jeder Sensor derart relativ zu dem 
Objekt angeordnet ist, dass die Gradienten-Betragswerte in 

10 der Gradientenmatrix significant sind. Man spricht von si- 
gnifikanten Gradienten-Betragswerten, wenn diese von dem 
Messrauschen der aufgenommenen Messdaten unterscheid- 
bar sind. Die Gradienten-Betragswerte sind bspw. unter- 
scheidbar, wenn sie etwa doppelt so groB sind wie das Mess- 

15 rauschen der aufgenommenen Messdaten. Falls die Gra- 
dientenstarke nicht ausreichend groB ist, wird der entspre- 
chende Gradienten-Betragswert als nicht vorhanden gewer- 
tet. Die Gradienten-Betragswerte in der Gradientenmatrix 
sind vorzugsweise in etwa mindestens dreimal so groB wie 

20 das Messrauschen, 

Die Kriterien der Monotonie der Folge der Messdaten, 
der Beobachtbarkeit der Regelung und der Gradientenstarke 
konnen durch die Position der Sensoren relativ zu dem Ma- 
nipulator beeinflusst werden. Der genaue Bezug der Senso- 

25 ren zu dem Manipulator ist allerdings von untergeordneter 
Bedeutung, solange die o. g. Kriterien erfullt sind. Der Be- 
zug der Sensoren zu dem Manipulator wird wahrend der 
Trainingsphase erfasst und uber die aufgenommenen und 
abgespeicherten Messdaten in der Regelung beriicksichtigt. 

30 GemaB einer bevorzugten Ausfuhrungsform der vorlie- 
genden Erfindung wird vorgeschlagen, dass der oder jeder 
Sensor als ein optischer Sensor, insbesondere als eine CCD- 
Kamera, ausgebildet ist. Mittels CCD-Kameras kann ein 
Objekt auf vielfaltige Weise charakterisiert werden. Es ist 

35 denkbar, dass die Messdaten bei als CCD-Kameras ausge- 
bildeten Sensoren als Abstande zwischen den Sensoren und 
dem Objekt, als Pixel auf dem CCD-Chip o. a. ausgebildet 
sind. CCD-Kameras haben zudem den Vorteil, dass ihr 
Blickfeld zum Ausrichten der Sensoren relativ zu dem Ob- 

40 jekt auf einem Bildschirm dargestellt werden kann. Das er- 
leichtert die Ausrichtung der Sensoren erheblich. 

Ein bevorzugtes Ausfuhrungsbeispiel der vorliegenden 
Erfindung wird im Folgenden anhand der Zeichnung naher 
erlautert. Es zeigt: 

45 Fig. 1 ein erfindungsgemaBes Handhabungsgerat gemaB 
einer bevorzugten Ausfuhrungsform; 

Fig, 2 den Manipulator des Handhabungsgerats aus Fig. 1 
im Ausschnitt; und 
Fig. 3 eine Verfahrbahn eines erfindungsgemaBen Hand- 

50 habungsgerats. 

In Fig. 1 ist ein erfindungsgemaBes Handhabungsgerat in 
seiner Gesamtheit mit dem Bezugszeichen 1 gekennzeich- 
net. Das Handhabungsgerat 1 weist einen Manipulator! auf, 
der in sechs Freiheitsgraden (x, y, z, a, b, c) bewegbar ist. 

55 Das Handhabungsgerat 1 ist bspw. als ein Industrie- Roboter 
ausgebildet, dessen Manipulator 2 bspw. als ein beliebiges 
Werkzeug oder als ein Messkopf zur Aufnahme beliebiger 
MessgroBen (Temperatur, Abstand, etc.) ausgebildet ist. 
Damit der Manipulator 2 die ihm zugedachte Aufgabe er- 

60 fullen kann, muss er in eine definierte Vorhalteposition (vgl. 
Fig. 2) relativ zu einem Objekt 3 gebracht werden. Unter 
dem Begriff Vorhalteposition wird gemaB dem vorliegenden 
Patent auch die Ausrichtung des Manipulators 2 relativ zu 
dem Objekt 3 verstanden. Die Erfindung schlagt ein Verfah- 

65 ren zur Regelung der Vorhalteposition vor. Das erfindungs- 
gemaBe Verfahren kann nicht nur fiir jede Art von Pick-and- 
place-Anwendungen, sondern auch fur Anwendungen, bei 
denen einem bestimmten Linienverlauf gefolgt werden 
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muss, bspw. zum SchweiBen, Kleben oder Abdichten von 
Kan ten, eingesetzt werden. 

GernaB dem vorliegenden Ausflihrungsbeispiel soli ein 
Schiebedach 4 eines Kraftfahrzeugs von dem Manipulator 2 
ergriffen und in eine entsprechende Offnung (Objekt 3) im 5 
Dach 5 der Karosserie des Kraftfahrzeugs eingesetzt wer- 
den. Der Manipulator 2 ist als ein Saugnapf zum Greifen des 
Schiebedachs 4 ausgebildet. Die Vorhalteposition ist eine 
Position oberhalb der Oftnung, von der aus das Schiebedach 
4 in einer geradlinigen, senkrechten Bewegung nach unten 10 
in die Oftnung bewegt werden kann. 

Das Handhabungsgerat 1 weist eine interne Steuerungs- 
einrichtung 6 auf. Auf der Steuerungseinrichtung 6 ist ein 
Steuerungsprogramm lauffahig, durch das der Manipulator 
2 entlang einer programmierten Verfahrbahn (vgl. Fig. 3) in 15 
die Vorhalteposition bewegt werden kann. Wenn das Objekt 
3, im vorliegenden Ausflihrungsbeispiel die Offnung im 
Dach 5 der Karosserie des Kraftfahrzeugs, stets an derselben 
Position angeordnet ist, reicht eine solche Steuerung der 
Verfahrbahn bis zur Vorhalteposition voilkommen aus. Falls 20 
die Position des Objekts 3 jedoch gewissen Schwankungen 
unterworfen ist, kann durch eine Steuerung alleine nicht 
mehr sichergestellt werden, dass eine bestimmte Vorhalt- 
eposition des Manipulators 2 relativ zu dem Objekt 3 stets 
mit der erforderlichen Genauigkeit eingenommen wird. 25 
Schwankungen des Objekts 3 konnen sich bspw. aufgrund 
von Ungenauigkeiten bei der Positionierung der Karosserie 
relativ zu dem Handhabungsgerat 1 oder aufgrund der Be- 
wegung der Karosserie des Kraftfahrzeugs auf einer Ferti- 
gungsstraBe ergeben. 30 

Urn sicherzustellen, dass die Vorhalteposition des Mani- 
pulators 2 relativ zu dem Objekt 3 auch bei Schwankungen 
der Position des Objekts 3 stets mit der geforderten Genau- 
igkeit eingenommen wird, wird in solchen Fallen die Vor- 
halteposition des Manipulators 2 relativ zu dem Objekt 3 ge- 35 
regelt. Aus dem Stand der Technik sind mehrere Verfahren 
zur Regelung der Vorhalteposition des Manipulators 2 be- 
kannt. Diese Verfahren sind jedoch sehr arbeits- und zeitauf- 
wendig. 

Das erfindungsgemaBe Verfahren zur Regelung der Vor- 40 
halteposition des Manipulators 2 weist verschiedene Merk- 
male zur Beschleunigung und Vereinfachung der Regelung 
auf. Das Verfahren ist auf einer externen Regelungseinrich- 
tung 7 implementiert (vgl. Fig. 1). Die Regelungseinrich- 
tung 7 ist als ein herkommlicher Personal-Computer (PC) 45 
oder Industrie-PC ausgebildet. Auf der Regelungseinrich- 
tung 7 ist ein Regelungsprogramm, das in einer herkommli- 
chen Programmiersprache programmiert ist, lauffahig. In 
Fig. 1 ist die Regelungseinrichtung 7 als von dem Handha- 
bungsgerat 1 getrennt ausgebildet. Es ist jedoch auch denk- 50 
bar, dass die Regelungseinrichtung 7 in das Handhabungs- 
gerat 1 integriert ist. Das Steuerungsprogramm der Steue- 
rungseinrichtung 6 ist in einer proprietaren, nur auf der 
Steuerungseinrichtung 6 dieses Handhabungsgerats 1 lauf- 
fahigen Programmiersprache programmiert. Das Steue- 55 
rungsprogramm weist an besummten Stellen Programmier- 
befehle (Aufrufbefehle, Ruckholbefehle) auf, um das Rege- 
lungsprogramm der externen Regelungsvorrichtung 7 von 
dem Steuerungsprogramm aus aufzurufen bzw. um von dem 
Regelungsprogramm wieder zu dem Steuerungsprogramm 60 
zuruckzukehren. Zwischen der Steuerungseinrichtung 6 und 
der Regelungseinrichtung 7 ist eine Datenleitung 8 zum 
Austausch von Daten vorgesehen. 

In Fig. 2 ist zu erkennen, dass an dem Manipulator 2 vier 
als CCD-Kameras ausgebildete Sensoren 9 angeordnet sind. 65 
Durch die Sensoren 9 werden die Verlaufe der Kanten 10 in 
Relation zu dem Manipulator 2 gesetzt. Dazu werden Mess- 
daten, die im vorliegenden Ausfuhrungsbeispiel als Pixel- 
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werte der CCD-Chips der Sensoren 9 ausgebildet sind, auf- 
genommen und in Messvektoren gespeichert. 

Das erfindungsgemaBe Verfahren zur Regelung der Vor- 
halteposition des Manipulators 2 relativ zu dem Objekt 3 
weist drei unterschiedliche Betriebszustande auf. In einem 
ersten Betriebszustand, dem sog. Record-Mode, wird die 
Verfahrbahn A bis B (vgl. Fig. 3) zu einer Vorhalteposition 
hin und von der Vorhalteposition weg von dem Steuerungs- 
programm der Steuerungseinrichtung 6 gesteuert abgefah- 
ren. In dem Bereich der Verfahrbahn zwischen den Punkten 
C und D liegt ein fur die Regelung interessanter Bereich mit 
einem oder mehreren Vorhaltepositionen des Manipulators 
2, die relativ zu dem Objekt 3 geregelt werden sollen. Wenn 
der Manipulator 2 beim Abfahren der Verfahrbahn den 
Punkt C erreicht hat, wird das Regelungsprogramm der Re- 
gelungseinrichtung 7 aufgerufen. Wahrend des gesteuerten 
Abfahrens der Verfahrbahn von dem Punkt C bis D werden 
dann einer oder mehrere Punkte von dem Regelungspro- 
gramm aufgenommen und gespeichert. Wenn die Verfahr- 
bahn den Punkt D erreicht hat, wird das Regelungspro- 
gramm beendet. Damit ist der Record-Mode beendet. Auf 
die gespeicherten Punkte der Verfahrbahn wird dann in ei- 
nem dritten Betriebszustand der Regelung zugegriffen. 

In einem zweiten Betriebszustand, dem sog. Parameter- 
Mode, fahrt der Manipulator 2 von dem Steuerungspro- 
gramm gesteuert die Verfahrbahn von dem Punkt A zu dem 
Punkt C ab. Wenn die Verfahrbahn den Punkt C erreicht hat, 
wird das Regelungsprogramm aufgerufen, und die Steue- 
rung des Manipulators 2 wird von dem Steuerungspro- 
gramm an das Regelungsprogramm abgegeben. Das Rege- 
lungsprogramm fahrt die gespeicherte Verfahrbahn zwi- 
schen den Punkten C und D ab. Auf der Verfahrbahn werden 
diejenigen Vorhaltepositionen angefahren, die relativ zu 
dem Objekt geregelt werden sollen, und fur jede Vorhalt- 
eposition wird eine Trainingsphase durchlaufen. Wenn die 
von dem Regelungsprogramm gesteuerte Verfahrbahn den 
Punkt D erreicht hat, wird das Regelungsprogramm beendet 
und die Steuerung des Manipulators 2 entlang der Verfahr- 
bahn wieder an das Steuerungsprogramm zuriickgegeben. 
Der Manipulator 2 fahrt dann von dem Steuerungspro- 
gramm gesteuert die restliche Verfahrbahn von dem Punkt D 
bis B ab. Damit ist der Parameter-Mode beendet. 

Fur jede Vorhalteposition, die relativ zu dem Objekt 3 ge- 
regelt werden soli, wird eine Trainingsphase durchgefuhrt. 
Dazu wird zunachst die Soli- Vorhalteposition mit dem Ma- 
nipulator 2 angefahren, und von den Sensoren 9 werden die 
Werte von 32 Messdaten, durch die die Soli- Vorhaltepos- 
ition charakterisiert ist, aufgenommen und in einem Soll- 
Messvektor y_soll gespeichert. Der Soil-Messvektor y_soll 
hat somit die Dimension 32 x 1 (32 Messdaten x 1 Wert). 
AnschlieBend wird der Manipulator 2 nacheinander um je- 
den der sechs Freiheitsgrade in funf Vorhaltepositionen in 
der einen Richtung der Soll-Vorhalteposiuon und in funf 
Vorhaltepositionen in der anderen Richtung der Soil- Vor- 
halteposition bewegt. In jeder Vorhalteposition werden die 
entsprechenden Werte der 32 Messdaten aufgenommen und 
in Messvektoren gespeichert. Aus den zehn Messvektoren 
und dem Soll-Messvektor y_soll wird dann fiir jeden der 
sechs Freiheitsgrade der Betrag des Gradienten eines be- 
stimmten Messdatums berechnet und in einer Gradienten- 
matrix C abgespeichert. Die Gradientenmatrix C hat somit 
die Dimension 32 x 6 (32 Messdaten x 6 Freiheitsgrade). 
Fiir jeden der zu regelnden Vorhaltepositionen erhalt man 
somit einen Soll-Messvektor y_soll und die Gradientenma- 
trix C. 

In einem dritten Betriebszustand, dem sog. Operation- 
Mode, fahrt der Manipulator 2 von dem Steuerungspro- 
gramm gesteuert die Verfahrbahn von dem Punkt A zu dem 
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Punkt C ab, Wenn die Verfahrbahn den Punkt C erreicht hat, 
wird das Regelungsprogramni aufgerufen, und die Steue- 
rung des Manipulators 2 wird von dem Steuerungspro- 
gramm an das Regelungsprogramm abgegeben. Das Rege- 
lungsprogramni fahrt die gespeicherte Verfahrbahn zwi- 5 
schen den Punkten C und D ab. Die gespeicherten Punkte 
der Verfahrbahn erlauben eine vorausschauende Regelung 
der Vorhaltepunkte auf der Verfahrbahn, was bei gleicher 
oder sogar hbherer Genauigkeit eine wesentlich hbhere Ver- 
fahrbahngeschwindigkeit als bei den aus dem Stand der 10 
Technik bekannten Verfahren zum Regeln der Vorhaltepos- 
ition eines Manipulators ermoglicht. 

In dem Bereich der Verfahrbahn zwischen den Punkten E 
und F liegt ein fur die Regelung interessanter Bereich mit ei- 
nem oder mehreren Vorhaltepositionen des Manipulators 2, is 
die relativ zu dem Objekt 3 geregelt werden sollen. Sobald 
die Verfahrbahn den Punkt E erreicht hat, erfolgt eine Rege- 
lung der Vorhalteposition auf der Verfahrbahn. Im Rahmen 
der Regelung der Vorhalteposition werden von den Senso- 
ren 9 zunachst in der momentanen 1st- Vorhalteposition die 20 
entsprechenden Werte der Messdaten aufgenommen und in 
einem Ist-Messvektor yjst gespeichert. Der Ist-Messvektor 
y_ist hat ebenfalls die Dimension 32 x 1 (32 Messdaten x 1 
Wert). Aus der Differenz des S oil-Mess vektors und des Ist- 
Messvektors wird ein Differenz-Messvektor D_y gebildet 25 
(D_y = y soil - y_ist). Der Differenz-Messvektor D_y hat 
ebenfalls die Dimension 32 x 1. Dann wird der Kehrwert 
der Gradientenmatrix C berechnet und wahlweise abgespei- 
chert. Aus dem Produkt des Kehrwerts des Gradienten vek- 
tors C und des Differenz- Mess vektors D_y wird ein Korrek- 30 
turvektor D_x ermittelt, der ebenfalls die Dimension 32 x 1 
hat. Es ist jedoch auch denkbar, dass der Korrekturvektor 
D_x mittels eines anderen geeigneten Verfahrens, bspw. 
durch den Einsatz eines sequentiellen Kalman filters, ermit- 
telt wird. 35 

Ein Teil des Korrekturvektors D_x, vorzugsweise etwa 
10% des Korrekturvektors D_x, wird zur Korrektur der Ist- 
Vorhalteposition des Manipulators 2 herangezogen. In der 
neuen Ist- Vorhalteposition werden erneut die entsprechen- 
den Werte der Messdaten aufgenommen und in einem Ist- 40 
Messvektor y_ist gespeichert. Wie oben bereits beschrieben 
wird erneut ein Korrekturvektor D_x berechnet und die Ist- 
Vorhalteposition in Abhangigkeit von dem Korrekturvektor 
D_x korrigiert. Die Korrektur der Ist- Vorhalteposition wird 
so lange wiederholt, bis die einzelnen Werte des Korrektur- 45 
vektors D_x ein bestimmtes Abbruchkriterium erfulit ha- 
ben, d. h. bis der Manipulator 2 auf die Soil- Vorhaltepos- 
ition geregelt ist. 

Patentanspruche 50 

1. Verfahren zur Regelung der Vorhalteposition eines 
in mehreren Freiheitsgraden bewegbaren Manipulators 
(2) eines Handhabungsgerats (1) relativ zu einem Ob- 
jekt (3) entlang einer Verfahrbahn, dadurch gekenn- 55 
zeichnet, dass mehrere Punkte zumindest eines Teils 
der Ist- Verfahrbahn gespeichert sind und fur eine vor- 
ausschauende Regelung der Vorhalteposition des Ma- 
nipulators (2) entlang dieses Teils der Verfahrbahn her- 
angezogen werden. 60 

2. Verfahren nach Anspruch 1, dadurch gekennzeich- 
net, dass die Ist- Verfahrbahn des Manipulators (2) vor 
der Regelung der Vorhalteposition abgefahren wird 
und dabei die Punkte zumindest eines Teils der Ist- Ver- 
fahrbahn aufgenommen und abgespeichert werden. 65 

3. Verfahren nach Anspruch 2, dadurch gekennzeich- 
net, dass die Ist- Verfahrbahn von dem Manipulator (2) 
vor der Regelung der Vorhalteposiuon von einer inter- 
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nen Steuerungseinrichtung (6) des Handhabungsgerats 

(1) gesteuert abgefahren wird. 

4. Verfahren nach Anspruch 2 oder 3, dadurch gekenn- 
zeichnet, dass die Punkte zumindest eines Teils der Ist- 
Verfahrbahn von einer externen Regelungseinrichtung 
(7) aufgenommen und abgespeichert werden. 

5. Verfahren nach Anspruch 3 und 4, dadurch gekenn- 
zeichnet, dass die exteme Regelungseinrichtung (7) 
von der interne n Steuerungseinrichtung (6) aufgerufen 
wird. 

6. Verfahren zur Regelung der Vorhalteposition eines 
in mehreren Freiheitsgraden bewegbaren Manipulators 

(2) eines Handhabungsgerats (1) relativ zu einem Ob- 
jekt (3) entlang einer Verfahrbahn, insbesondere nach 
einem der Anspriiche 1 bis 5, dadurch gekennzeichnet, 
dass die Soil- Vorhalteposition des Manipulators (2) vor 
der Regelung der Vorhalteposition angefahren wird, 
wahrend einer Veranderung der Soli- Vorhalteposition 
urn jeweils einen Freiheitsgrad Messdaten, durch die 
die Vorhalteposition des Manipulators (2) charakteri- 
siert ist, aufgenommen und gespeichert werden und die 
Regelung der Vorhalteposition in Abhangigkeit von 
den Messdaten durchgefuhrt wird. 

7. Verfahren nach Anspruch 6, dadurch gekennzeich- 
net, dass vor der Regelung der Vorhalteposition 

- die Soil- Vorhalteposition angefahren wird, 

- ein Soll-Messvektor (y_soll) mit den Messda- 
ten aufgenommen wird, 

- fur jeden Freiheitsgrad der Manipulator (2) des 
Handhabungsgerats (1) aus der Soil- Vorhaltepos- 
ition heraus in mehrere Vorhaltepositionen be- 
wegt und in jeder Vorhalteposition ein Messvektor 
aufgenommen wird, 

- fiir jeden Freiheitsgrad fur dieselben Messdaten 
der Messvektoren der Betrag des Gradienten er- 
mittelt und in einer Gradientenmatrix (C) gespei- 
chert wird, und im Rahmen der Regelung der Vor- 
halteposition 

- ein Korrekturvektor (D_x) aus der Multiplika- 
tion des Kehrwerts der Gradientenmatrix (C) mit 
der Differenz des Soll-Messvektors (y_soll) und 
eines Ist-Messvektors (y_ist) in der Ist- Vorhalt- 
eposition des Manipulators (2) oder anhand eines 
anderen geeigneten Verfahrens ermittelt wird und 

- die Vorhalteposition in Abhangigkeit von dem 
Korrekturvektor (D_x) geregelt wird. 

8. Verfahren nach Anspruch 7, dadurch gekennzeich- 
net, dass die Ist- Vorhalteposition des Manipulators (2) 
im Rahmen der Regelung der Vorhalteposition um ei- 
nen Bruchteil des Korrekturvektors (D_x) korrigiert 
wird und anschlieBend der Ist-Messvektor (y_ist) in der 
korrigierten Ist- Vorhalteposition und daraus der Kor- 
rekturvektor (D_x) erneut ermittelt wird. 

9. Verfahren nach Anspruch 8, dadurch gekennzeich- 
net, dass die Regelung der Vorhalteposition abgebro- 
chen wird, wenn jedes der Elemente des Korrekturvek- 
tors (D_x) kleiner als ein Abbruchkriterium ist. 

10. Verfahren nach Anspruch 8 oder 9, dadurch ge- 
kennzeichnet, dass fur jeden Freiheitsgrad von der 
Soli- Vorhalteposition aus mindestens zwei Messvekto- 
ren in jede Richtung aufgenommen werden. 

11. Verfahren nach Anspruch 10, dadurch gekenn- 
zeichnet, dass fiir jeden Freiheitsgrad von der Soli- Vor- 
halteposition aus funf Messvektoren in jede Richtung 
aufgenommen werden. 

12. Verfahren nach einem der Anspriiche 1 bis 5, da- 
durch gekennzeichnet, dass die Messvektoren zusam- 
men mindestens sechs Messdaten enthalten, damit die 
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Position und Ausrichtung des Manipulators (2) relativ 
zu dem Objekt (3) im dreidimensionalen Raum charak- 
terisiert ist. 

13. Verfahren nach Anspruch 12, dadurch gekenn- 
zeichnet, dass die Messvektoren jeweils 32 Messdaten 5 
enthalten. 

14. Vorrichtung zur Regelung der Vorhalteposition ei- 
nes in mehreren Freiheitsgraden bewegbaren Manipu- 
lators (2) eines Handhabungsgerats (1) relativ zu einem 
Objekt (3) entlang einer Verfahrbahn, dadurch gekenn- to 
zeichnet, dass die Vorrichtung Mittel zur Durchfuhrung 
des Verfahrens nach einem der Anspriiche 1 bis 13 auf- 
weist. 

15. Handhabungsgerat (1) mit einem in mehreren Frei- 
heitsgraden bewegbaren Manipulator (2), dessen Vor- 15 
halteposiuon relativ zu einem Objekt (3) regelbar ist, 
dadurch gekennzeichnet, dass das Handhabungsgerat 
(9) Mittel zur Durchfuhrung des Verfahrens nach ei- 
nem der Anspriiche 1 bis 13 aufweist. 

16. Handhabungsgerat (1) nach Anspruch 15, dadurch 20 
gekennzeichnet, dass an dem Manipulator (2) des 
Handhabungsgerats (1) zur Ermittlung der Ist- Vorhalt- 
eposition des Manipulators (2) relativ zu dem Objekt 
(3) mindestens ein Sensor (9) befestigt ist. 

17. Handhabungsgerat (1) nach Anspruch 16, dadurch 25 
gekennzeichnet, dass der oder jeder Sensor (9) derart 
relativ zu dem Objekt (3) angeordnet ist, dass die Folge 
der Messdaten der fur einen Freiheitsgrad aufgenom- 
menen Messvektoren streng monoton ist. 

18. Handhabungsgerat (1) nach Anspruch 17, dadurch 30 
gekennzeichnet, dass in der Gradienten matrix (C) fiir 
jeden Freiheitsgrad jeweils fur mindestens ein aufge- 
nommenes Messdatum ein Gradienten-Betragswert 
enthalten ist. 

19. Handhabungsgerat (1) nach Anspruch 18, dadurch 35 
gekennzeichnet, dass die Gradienten-Betragswerte in 
der Gradientenmatrix (C) significant sind. 

20. Handhabungsgerat (1) nach einem der Anspriiche 
15 bis 19, dadurch gekennzeichnet, dass der oder jeder 
Sensor (9) als ein optischer Sensor ausgebildet ist. 40 

21. Handhabungsgerat (1) nach Anspruch 20, dadurch 
gekennzeichnet, dass der oder jeder Sensor (9) als eine 
CCD-Kamera ausgebildet ist. 
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METHOD AND DEVICE FOR CONTROLLING THE INTERMEDIATE POSITION 
OF A MANIPULATOR OF A HANDLING DEVICE 

[0001] The present invention relates to a method and to a device for controlling the 
intermediate position 1 of a manipulator of a handling device that is movable in a plurality of 
degrees of freedom, relative to an object along a traverse path. The present invention also 
relates to a handling device having a manipulator that is movable in a plurality of degrees of 
freedom and whose intermediate position relative to an object is controllable. 

[0002] The handling device is designed, for example, as a multi-jointed industrial robot. 
Industrial robots of this kind are used, in particular, in the automotive industry, [specifically] 
in production and quality assurance. The manipulator can have any given design to 
accommodate the various possible applications of an industrial robot. 

[0003] The manipulator is designed, for example, as a tool, in particular as a welding 
device, as a device for applying adhesive, paint, or other coatings to a surface, as a processing 
device, or the like. The manipulator can be designed as a gripper, as a suction cup, or the like, 
for grasping one or more objects. Finally, it is conceivable for the manipulator to be designed 
as a sensing head, for example, for measuring the surface profile of an object, a gap width, a 
gap offset, a coating thickness, or the like. 

[0004] In order for the manipulator to perform its designated task, it is necessary to move 
it into a defined intermediate position relative to an object. In accordance with the present 
patent [sic. invention], intermediate position is understood to be both the positioning, as well 
as orientation of the manipulator relative to the object. 



1 Translator's note: "Intermediate position" was selected as the translation for "Vorhalteposition." 
Siemens refers to this as "predicted position," in other words "the position reached by the robot if it 
moves with the selected velocity for the next time interval and then stops with maximal decelerations." 
Since this application speaks often of "predictive control of the position," calling it "predictive control of 
the predicted position" would have been redundant. Other terms used in the literature include "limit 
point," "deceleration point," "anticipation point," "prestop," "ready position," and "forward limit 
position." 



[0005] From the related art, handling devices are known which have an internal open-loop 
control device. In response to an open-loop control program, which is executable on the open- 
loop control device, the manipulator can be moved along a programmed traverse path into the 
intermediate position. When the object is always located at the same position, this type of 
control of the traverse path up to the intermediate position suffices entirely. However, if the 
position of the object is subject to certain fluctuations, as is normally the case, it is no longer 
possible to ensure, alone by an open-loop control, that a defined intermediate position of the 
manipulator relative to the object will always be able to be assumed with the requisite 
precision. There can be many different causes of fluctuations in the position of the object. 

[0006] To ensure that the intermediate position of the manipulator relative to the object is 
always assumed with the requisite precision, even in the case of positional fluctuations of the 
object, it is likewise known from the related art to control the intermediate position of the 
manipulator relative to the object. Different methods for controlling the intermediate position 
of the manipulator are known from the related art. However, these known methods for 
controlling the intermediate position are very complicated and slow. 

[0007] In the course of controlling the intermediate position of the manipulator relative to 
an object, the actual intermediate position of the manipulator is initially recorded by sensors 
and then controlled to a setpoint intermediate position. The sensors are designed, for example, 
as optical or as tactile sensors. 

[0008] In particular, they are designed as laser sensors for measuring distances, as 
force/moment sensors for measuring forces or moments, or as contact sensors for detecting a 
contacting of the object. 

[0009] The sensors are arranged in a specific relation (position and orientation) to the 
manipulator. Before the control of the intermediate position is carried out, the sensors must be 
brought into a specific relation with the manipulator and the object (set up), and the 
parameters of the control must be adapted to the specific relation (calibration). The relation 
between the sensors and the manipulator can change due to temperature fluctuations, 
mechanical actions on the sensors or the manipulator, or the like, thereby necessitating a 
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repeated calibration and possibly even a repeated setting up of the device for implementing 
the control. During set-up and calibration, the device is not available for a control; the process 
of controlling the intermediate position must be interrupted. 

[0010] Moreover, all of the known methods for controlling the intermediate position of 
the manipulator have the disadvantage that the traversing velocity of the manipulator is 
relatively low, since the control is carried out without knowledge of the manipulator traverse 
path to be controlled that lies ahead. For that reason, the traversing velocity must be selected 
to be low enough to ensure a rapid and precise positioning of the manipulator, even in the 
extreme case of a reversal in the traversing direction. A too-high traversing velocity in the 
context of highly curved traverse paths or a reversal in the traversing direction would cause 
the manipulator to overshoot the controlled traverse path and thereby leave the same. 

[001 1] It is, therefore, an object of the present invention to develop and further refine a 
method of the type mentioned at the outset in a way that will enable a fastest possible control 
of the intermediate position to be achieved and, in particular, higher traversing velocities of 
the manipulator on the traverse path to be realized, without incurring any loss of control 
precision. 

[0012] To achieve this objective, starting out from the method of the type mentioned at 
the outset, the present invention provides that a plurality of points of at least one portion of 
the actual traverse path be stored, and that a predictive control of the intermediate position of 
the manipulator along this portion of the traverse path be consulted. 

[0013] It has been discovered in accordance with the present invention that, through the 
use of a predictive control, it is possible to substantially accelerate the control of the 
intermediate position in a simple manner. The configuration of the traverse path that lies 
ahead is considered during the predictive control of the intermediate position. When 
permitted by the configuration of the traverse path that lies ahead, for example when working 
with a straight or an only slightly curved traverse path, a high traversing velocity may be 
selected for the manipulator. This makes it possible to substantially accelerate the control of 
the intermediate position along a traverse path. In the case of increasing curvature of the 
traverse path that lies ahead, it is necessary to increasingly reduce the traversing velocity. In 
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addition, by selecting a low traversing velocity when working with pronounced curvatures of 
the upcoming traverse path, it is possible to signficantly enhance the accuracy of the control 
of the manipulator's intermediate position along the traverse path. Thus, in accordance with 
the method of the present invention, the traversing velocity may be individually adapted to the 
configuration of the traverse path that lies ahead. 

[0014] The points of the actual traverse path may be determined in different ways, for 
example empirically, through simulation, or by calculation. When the points of the actual 
traverse path are determined empirically, the individual points may be approached by the 
manipulator of the handling device either manually or in a process controlled by a first open- 
loop control device. When the points are determined through simulation, a model of the 
handling device and of the object is first generated, preferably on a computer. On the basis of 
this model, the actual traverse path is then determined by simulating the traverse path. When 
the points of the actual traverse path are computed mathematically, a mathematical model of 
the handling device and of the object is first generated; and the points are then computed by 
solving mathematical equations. 

[0015] In accordance with one advantageous embodiment of the present invention, the 
actual traverse path of the manipulator is traveled prior to the process of controlling the 
intermediate position and, in the process, the points of at least one portion of the actual 
traverse path are recorded and stored. There is no need for stringent demands to be placed on 
precision when traveling [covering] the actual traverse path, since the traverse path may be 
corrected during the subsequent control of the traverse path of the manipulator. The traveled 
actual traverse path merely represents an estimation of the configuration of the setpoint 
traverse path and must be accurate enough to be used for a predictive control of the 
manipulator's intermediate position along the traverse path. 

[0016] The actual traverse path is advantageously traveled in a controlled process by the 
manipulator before the intermediate position is controlled by an internal open-loop control 
device of the handling device. An open-loop control program, in which the individual points 
of the actual traverse path are programmed, is executed on the internal open-loop control 
device. The handling device is driven by the open-loop control program in such a way that, 
during execution thereof, the manipulator travels the actual traverse path. In the process, the 
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points of at least one portion of the actual traverse path are recorded and stored. Apart from 
the points of the actual traverse path programmed in the open-loop control program, 
additional points of the actual traverse path may be recorded and stored. 

[0017] The points of at least one portion of the actual traverse path are preferably recorded 
and stored by an external closed-loop control device. A closed-loop control program, which 
controls the intermediate position of the manipulator on the traverse path, is executed on the 
external closed-loop control device. The external closed-loop control device is designed, for 
example, as a personal computer (PC) or as an industrial personal computer. The closed-loop 
control program may be programmed in a standard programming language and be 
reprogrammed without entailing substantial outlay. Before controlling the intermediate 
position, the closed-loop control program may also record and store the points of the actual 
traverse path traveled by the manipulator, in one specific mode (record mode). The stored 
points are then consulted in another mode (operation mode) for the predictive control of the 
intermediate position. 

[0018] Another advantageous embodiment of the present invention provides for the 
external closed-loop control device to be invoked by the internal open-loop control device. 
The open-loop control program of the internal open-loop control device is typically 
programmed in a proprietary programming language that is only executable on the open-loop 
control device of a specific handling device. Considerable outlay would have to be expended 
to integrate the entire closed-loop control program into the open-loop control program. For 
that reason, specific programming instructions (invocation instructions, return instructions) 
are provided in the open-loop control program, in order to invoke the closed-loop control 
program of the external closed-loop control device from the open-loop control program. 2 
Little outlay is needed to insert these programming instructions into the open-loop control 
program. Depending on the mode in which the control is operated, by invoking the closed- 
loop control program of the closed-loop control device, the points of the actual traverse path 
are recorded and stored (record mode), or the intermediate position is predictively controlled 
(operation mode). 



2 Translator's note: This sentence should perhaps include "or to return again from the closed-loop control 
program to the open-loop control program" as stated in paragraph 0056. 
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[00191 In accordance with another advantageous embodiment of the present invention, 
prior to control of the intermediate position, the setpoint intermediate position of the 
manipulator is approached; measurement data characterizing the intermediate position of the 
manipulator are collected and stored while the setpoint intermediate position is changed in 
each instance by one degree of freedom; and the intermediate position is controlled as a 
function of the measurement data. A correlation exists between the collected measurement 
data and the position of the manipulator. Thus, information pertaining to the position of the 
manipulator is contained in the collected measurement data. 

[0020] In another mode (parameter mode), the setpoint intermediate position is 
approached prior to control of the intermediate position. To approach the setpoint 
intermediate position in the parameter mode, the points of the actual traverse path stored in 
the record mode are consulted. As soon as the setpoint intermediate position is reached, a 
training phase begins, in which information required for the later control of the intermediate 
position carried out within the context of the operation mode, is ascertained. 

[0021] During the training phase, the manipulator is moved by the setpoint intermediate 
position, in each case by one degree of freedom, into different intermediate positions relative 
to the object. The manipulator is moved by each degree of freedom into intermediate 
positions that preferably reside on both sides of the setpoint intermediate position. The 
intermediate positions of the manipulator are ascertained by sensors which are preferably 
affixed to the manipulator. The sensors supply measurement data, on whose basis an 
intermediate position of the manipulator is characterized. The measurement data include, for 
example, the distances from the sensors to the object, [and] forces or moments exerted by the 
object on the sensors. The measurement data may also be photogrammetric data. 
Photogrammetric data are collected by measuring images that were captured by a CCD 
camera or the like. In the course of the training phase, the measurement data are collected for 
each of the degrees of freedom for each of the intermediate positions. It is conceivable for the 
stored measurement data to be further processed for the control of the intermediate position. 
The training phase for this setpoint intermediate position is then concluded. The manipulator 
may approach another setpoint intermediate position and run through another training phase 
for this setpoint intermediate position until all setpoint intermediate positions have been 
approached. The parameter mode is then complete. The later control of the intermediate 
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position performed in the context of the operation mode is carried out as a function of the 
stored measurement data. 

[0022] In the method according to the present invention, the training phase replaces the 
requisite set-up (positioning of the sensors relative to the object) and calibration (setting the 
parameters of the control) processes typical of conventional methods known from the related 
art for controlling the intermediate position of the manipulator of a handling device. 

[0023] In this method as well, in which a training phase is executed prior to controlling of 
the intermediate position, a plurality of points of at least one portion of the actual traverse 
path are stored and are consulted for a predictive control of the intermediate position of the 
manipulator along this portion of the traverse path. However, the process of executing a 
training phase prior to control of the intermediate position is associated with the advantages 
indicated, even without these features of the characterizing part of claim 1 . Therefore, the 
protection of the patent [sic. the protection sought] should also relate to a method of the last 
mentioned type, in which the features set forth in the characterizing part of claim 1 are 
missing. 

[0024] In accordance with one preferred specific embodiment of the present invention, 
prior to controlling of the intermediate position: 

- the setpoint intermediate position is approached; 

- a setpoint measurement vector is recorded using the measurement data; 

- for each degree of freedom, the manipulator of the handling device is moved out of the 
setpoint intermediate position into a plurality of intermediate positions, and a measurement 
vector is recorded in each intermediate position; 

- for each degree of freedom, the absolute value of the gradient is determined for the same 
measurement data of the measurement vectors and is stored in a gradient matrix; and, in the 
course of the control of the intermediate position, 

- a correction vector is determined by multiplying the inverse value of the gradient matrix by 
the difference between the setpoint measurement vector and an actual measurement vector in 
the actual intermediate position of the manipulator or on the basis of another suitable method; 
and 

- the intermediate position is controlled as a function of the correction vector. 
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[0025] In accordance with this preferred specific embodiment, in the training phase in the 
parameter mode, the measurement data collected for the setpoint intermediate position are 
stored in a setpoint measurement vector, and the measurement data that were recorded for 
intermediate positions approached in the course of the training phase, are stored in 
measurement vectors. Thus, for each degree of freedom by which the manipulator is movable, 
a plurality of intermediate positions are approached from the setpoint intermediate position in 
each direction, and a measurement vector is recorded in each intermediate position. The 
dimension of the measurement vectors corresponds to the number of measurement data 
recorded for each intermediate position. The dimension of all measurement vectors is equal in 
magnitude. 

[0026] The measurement vectors and the setpoint measurement vector are then further 
processed for each degree of freedom. From the same measurement data of the measurement 
vectors of one degree of freedom, the absolute value of the gradient is ascertained and stored 
in a gradient matrix. Thus, the gradient matrix has the dimensions (number of the 
measurement data recorded for each intermediate position) x (number of the degrees of 
freedom). It is conceivable to compute and store the inverse value of the gradient matrix 
already in the parameter mode. Preferably, however, it is first calculated in the subsequent 
operation mode. This concludes the training phase for this setpoint intermediate position. The 
gradient matrix may also be termed Jacobi matrix or sensitivity matrix. 

[0027] In the course of the operation mode, an actual measurement vector is then 
ascertained for the control of the intermediate position of the manipulator, i.e., the 
measurement data are determined in the instananeous intermediate position of the 
manipulator of the handling device and stored in the actual measurement vector. A 
differential vector is then formed from the difference between the setpoint measurement 
vector and the actual measurement vector. In addition, the inverse value of the gradient 
matrix is computed and optionally stored. 

[0028] Finally, a correction vector is computed from the multiplication of the inverse 
value of the gradient matrix by the differential vector, and the intermediate position is 
controlled as a function of the correction vector. 
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[0029] The correction vector may also be determined using another suitable method, for 
example by using a sequential Kalman filter. Suitable methods of this kind for calculating the 
correction vector are known from the related art and can be used by one skilled in the art in 
any desired manner. The advantage of these other suitable methods is that the need is 
eliminated for the relatively complex process of forming the inverse value of the gradient 
matrix. 

(0030] During the operation mode, the manipulator first travels the traverse path in 
accordance with the points stored during the record mode. This traverse path is then corrected 
in the course of the control of the intermediate position of the manipulator with the aid of the 
correction vector. Thus, in accordance with the method of the present invention, the control 
of the intermediate position is not absolute; rather, it is merely relative to an intermediate 
position on the stored traverse path. 

[0031] The actual intermediate position is advantageously corrected in the course of the 
control of the intermediate position by a fraction of the correction vector, and the actual 
measurement vector in the corrected actual intermediate position and the correction vector 
derived therefrom, are ascertained once more. Thus, the actual intermediate position is not 
corrected by the entire correction vector. To prevent overshooting of the control, the attempt 
is made rather to approach the setpoint intermediate position slowly from one direction. This 
results in a control having a damped transient response. By suitably selecting the fraction of 
the correction vector, it is possible to determine the damping constant of the control. 

[0032] The control of the intermediate position is preferably discontinued when each of 
the elements of the correction vector is smaller than an abort criterion. By properly selecting 
the abort criterion, it is possible to determine the precision of the control on the one hand, and 
the control speed on the other hand. The smaller the value of the abort criterion is selected, 
the more precisely the control of the intermediate position may be implemented. However, a 
small value of the abort criterion also signifies that the control requires more time until the 
abort criterion is met. 

[0033] To ensure a controllability of the intermediate position of the manipulator within a 
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specific work volume of the control, the recorded measurement vectors should cover the 
entire work volume to the extent possible. In addition, for each degree of freedom, it is 
necessary to record as many measurement vectors as needed to make possible a reliable 
computation of the absolute value of the gradient of the measurement data. Therefore, one 
preferred specific embodiment of the present invention provides for at least two measurement 
vectors to be recorded in each direction for each degree of freedom, from the setpoint 
intermediate position. It is advantageous, however, for each degree of freedom, for five 
measurement vectors to be recorded in each direction, from the setpoint intermediate position. 
Thus, for each degree of freedom, ten measurement vectors and the setpoint measurement 
vector, thus eleven measurement vectors are derived. For each measuring datum that is 
recorded and stored in the measurement vectors, the absolute value of the gradient is 
computed and stored in the gradient matrix. 

[0034] For each degree of freedom in which the intermediate position of the manipulator 
of the handling device is controlled, the measurement vectors, together, must contain at least 
one independent measuring datum. Another preferred specific embodiment of the present 
invention provides for the measurement vectors, together, to contain at least six measurement 
data. This makes it possible for the position and orientation of the manipulator relative to the 
object to be uniquely characterized in six degrees of freedom. As a result, the intermediate 
position of the manipulator may be controlled by six degrees of freedom in three-dimensional 
space. The measurement vectors preferably each contain 32 measurement data. 

[0035] Another object of the present invention is to develop and further refine a device of 
the type mentioned at the outset in a way that will enable a fastest possible control of the 
intermediate position to be achieved and, in particular, higher traversing velocities of the 
manipulator on the traverse path to be realized, without incurring any loss of control 
precision. 

[0036] To achieve this objective, starting out from the device of the type mentioned at the 
outset, the present invention provides that the device have means for implementing the 
method according to one of the claims 1 through 13. 

[0037] Finally, another object of the present invention is to develop and further refine a 
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handling device of the type mentioned at the outset in a way that will enable a fastest possible 
control of the intermediate position to be achieved and, in particular, higher traversing 
velocities of the manipulator on the traverse path to be realized, without incurring any loss of 
control precision. 

[0038] To achieve this objective, starting out from the device of the type mentioned at the 
outset, the present invention provides that the handling device have means for implementing 
the method according to one of the claims 1 through 13. 

[0039] The device according to the present invention and the handling device according to 
the present invention have, in particular, means in order, in a record mode, to store a plurality 
of points of at least one portion of the actual traverse path and then, in an operation mode, to 
consult the stored points for a predictive control of the intermediate position of the 
manipulator along this portion of the traverse path. In addition, the device according to the 
present invention and the handling device according to the present invention have means in 
order, in a parameter mode, to drive the manipulator into a setpoint intermediate position; in 
the course of a training phase, to move the manipulator by the individual degrees of freedom 
of the handling device into other intermediate positions; and, for each degree of freedom, to 
record and store the measurement data in each intermediate position, thereby characterizing 
the corresponding intermediate position. 

[0040] In the case of the device according to the present invention and the handling device 
according to the present invention, the predictive control allows an especially high traversing 
velocity to be selected for the manipulator. Moreover, the training phase replaces the 
processes of setting up and calibrating the sensors. Thus, the device according to the present 
invention and the handling device according to the present invention make possible a more 
rapid control of the intermediate position, without incurring any loss of control precision. 

[0041] One advantageous embodiment of the present invention provides for at least one 
sensor to be affixed to the manipulator of the handling device to ascertain the actual 
intermediate position of the manipulator relative to the object. 

[0042] The or each sensor is advantageously positioned relative to the object in such a 
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way that the sequence of the measurement data of the measurement vectors recorded for one 
degree of freedom is strictly monotonic. This important condition must be met to always 
allow the manipulator to be controlled from all positions and orientations relative to the 
object into the desired setpoint intermediate position. 

[0043] In addition, the observability of the control must be ensured. For that reason, 
another advantageous specific embodiment of the present invention provides for the or each 
sensor to be positioned relative to the object in such a way that one absolute gradient value is 
contained in the gradient matrix for each degree of freedom, in each instance for at least one 
recorded measurement datum. 

[0044] To enable the [sic. WORD MISSING - absolute gradient values?] in the 

gradient matrix to also be processed in the course of controlling the intermediate position and 
to lead to a reliable result, it is provided that the or each sensor be positioned relative to the 
object in such a way that the absolute gradient values in the gradient matrix are significant. 
One speaks of significant absolute gradient values when they are distinguishable from the 
measurement noise of the collected measurement data. The absolute gradient values are 
distinguishable, for example, when they are approximately twice as great as the measurement 
noise of the recorded measurement data. In the case that the gradient magnitude does not 
suffice, the absolute gradient value in question is interpreted as non-existent. The absolute 
gradient values in the gradient matrix are preferably approximately at least three times as 
great as the measurement noise. 

[0045] The criteria of monotony of the sequence of the measurement data, of observability 
of the control, and of gradient magnitude may be influenced by the position of the sensors 
relative to the manipulator. However, the precise relation of the sensors to the manipulator is 
of secondary importance, as long as the criteria mentioned above are fulfilled. The relation of 
the sensors to the manipulator is detected during the training phase and considered in the 
control as a function of the recorded and stored measurement data. 

[0046] One preferred specific embodiment of the present invention provides for the or 
each sensor to be designed as an optical sensor, in particular as a CCD camera. One object 
may be characterized in numerous ways through the use of CCD cameras. When working 
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with sensors designed as CCD cameras, it is conceivable that the measurement data be 
constituted as distances between the sensors and the object, as pixels on the CCD chip or the 
like. In addition, CCD cameras have the advantage that their field of view can be displayed on 
a screen, when aligning the sensors relative to the object. This substantially facilitates the 
process of aligning the sensors. 

[0047] One preferred exemplary embodiment of the present invention is described in more 
detail below with reference to the drawings, in which: 

[0048] FIG. 1 : shows a handling device according to the present in accordance with 
one preferred specific embodiment; 

[0049] FIG. 2: the manipulator of the handling device of FIG. 1 , in a detail view; and 

[0050] FIG. 3: a traverse path of a handling device according to the present invention. 

[0051] In FIG. 1, a handling device according to the present invention is denoted in its 
entirety by reference numeral 1. Handling device 1 has a manipulator 2, which is movable in 
six degrees of freedom (x, y, z, a, b, c). Handling device 1 is designed, for example, as an 
industrial robot whose manipulator 2 is designed, for example, as any given tool or as a 
sensing head for recording any given measured quantities (temperature, distance, etc.). 

[0052] In order for manipulator 2 to perform its designated task, it must be moved to a 
defined intermediate position relative to an object 3 (compare FIG. 2). In accordance with the 
present patent [sic. invention], intermediate position is understood to also include the 
orientation of manipulator 2 relative to object 3. The present invention provides a method for 
controlling the intermediate position. The method according to the present invention is not 
only suited for all types of pick-and-place applications, but also for applications in which a 
defined linear sequence must be followed, such as for welding, bonding or sealing of edges. 

[0053] In accordance with the present exemplary embodiment, a sunroof 4 of a motor 
vehicle is to be grasped by manipulator 2 and inserted in a corresponding opening (object 3) 
in roof 5 of the body of the motor vehicle. Manipulator 2 is designed as a suction cup for 
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grasping sunroof 4. The intermediate position is a position above the opening from where 
runroof 4 may be moved in a rectilinear, vertical motion downwards into the opening. 

[0054] Handling device 1 has an internal open-loop control device 6. In response to an 
open-loop control program, which is executable on open-loop control device 6, manipulator 2 
may be moved along a programmed traverse path (compare FIG. 3) into the intermediate 
position. When object 3, in the present exemplary embodiment, the opening in roof 5 of the 
motor vehicle body, is always located at the same position, such a control of the traverse path 
up to the intermediate position suffices entirely. However, if the position of object 3 is subject 
to certain fluctuations, it is no longer possible to ensure, alone through the use of an open- 
loop control, that a defined intermediate position of manipulator 2 relative to object 3 will 
always able to be assumed with the necessary precision. Fluctuations of object 3 may arise, 
for example, as the result of inaccuracies during positioning of the body relative to handling 
device 1 or due to motion of the body of the motor vehicle on a production line. 

[0055] To ensure that the intermediate position of manipulator 2 relative to object 3 is 
always assumed with the necessary precision, even in the case of fluctuations of the position 
of object 3, in such cases, the intermediate position of manipulator 2 relative to object 3 is 
controlled in closed loop. Several methods for controlling the intermediate position of 
manipulator 2 in closed loop are known from the related art. However, these methods are very 
labor-intensive and time-consuming. 

[0056] The method according to the present invention for the closed-loop control of the 
intermediate position of manipulator 2 includes various features for accelerating and 
simplifying the closed-loop control. The method is implemented on an external closed-loop 
control device 7 (compare FIG. 1). Closed-loop control device 7 is designed as a conventional 
personal computer (PC) or as an industrial personal computer. A closed-loop control 
program, which is programmed in a conventional programming language, is executable on 
control device 7. In FIG. 1, closed-loop control device 7 is configured separately from 
handling device 1. It is also conceivable, however, for closed-loop control device 7 to be 
integrated in handling device 1. The open-loop control program of open-loop control device 6 
is programmed in a proprietary programming language that is only executable on open-loop 
control device 6 of this handling device 1 . At certain locations, the open-loop control program 
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has programming instructions (invocation instructions, return instructions), to invoke the 
closed-loop control program of external closed-loop control device 7 from the open-loop 
control program or to return again from the closed-loop control program to the open-loop 
control program. A data line 8 for exchanging data is provided between open-loop control 
device 6 and closed-loop control device 7. 

[0057] In FIG. 2, it is discernible that four sensors 9 designed as CCD cameras are 
mounted on manipulator 2. Sensors 9 are used to establish a relation between the form of 
edges 10 and manipulator 2. To that end, measurement data, which in the present exemplary 
embodiment are constituted as pixel values of the CCD chips of sensors 9, are collected and 
stored in measurement vectors. 

[0058] The method according to the present invention for controlling the intermediate 
position of manipulator 2 relative to object 3 features three different operating states. In a first 
operating state, the so-called record mode, traverse path A through B (compare FIG. 3) is 
traveled under open-loop control by open-loop control program of open-loop control device 6 
towards an intermediate position and away from the intermediate position. Located in the area 
of the traverse path between points C and D is a region of interest for the closed-loop control 
that includes one or more intermediate positions of manipulator 2, which are to be controlled 
in closed-loop relative to object 3. In response to manipulator 2 reaching point C as it travels 
the traverse path, the closed-loop control program of closed-loop control device 7 is invoked. 
While the traverse path is traveled in open-loop control from point C through D, one or more 
points are then recorded and stored by the closed-loop control program. When the traverse 
path has reached point D, the closed-loop control program is ended. This ends the record 
mode. The stored points of the traverse path are then accessed in a third operating state of the 
closed-loop control. 

[0059] In a second operating state, the so-called parameter mode, manipulator 2 travels 
the traverse path from point A to point C under control of the open-loop control program. 
When the traverse path has reached point C, the closed-loop control program is invoked, and 
the open-loop control program cedes control of manipulator 2 to the closed-loop control 
program. The closed-loop control program travels the stored traverse path between points C 
and D. On the traverse path, those intermediate positions are approached which are to be 
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controlled in closed-loop relative to the object, and a training phase is executed for each 
intermediate position. When the traverse path controlled by the closed-loop control program 
has reached point D, the closed-loop control program is ended, and the control of manipulator 
2 along the traverse path is again returned to the open-loop control program. Manipulator 2 
then travels the remaining traverse path from point D through B under control of the open- 
loop control program. This ends the parameter mode. 

[0060] A training phase is executed for each intermediate position which is to be 
controlled in closed loop relative to object 3. To that end, the setpoint intermediate position is 
first approached by manipulator 2, and the values of 32 measurement data which characterize 
the setpoint intermediate position, are recorded by sensors 9 and stored in a setpoint 
measurement vector y_setpoint. Thus, setpoint measurement vector y setpoint has the 
dimension 32 x 1 (32 measurement data x 1 value). Manipulator 2 is subsequently moved by 
each of the six degrees of freedom, one after another, into five intermediate positions in the 
one direction of the setpoint intermediate position and into five intermediate positions in the 
other direction of the setpoint intermediate position. In each intermediate position, the 
corresponding values of the 32 measurement data are recorded and stored in measurement 
vectors. From the ten measurement vectors and setpoint measurement vector y setpoint, the 
absolute value of the gradient of a specific measurement datum is then computed for 
each of the six degrees of freedom and is stored in a gradient matrix C. Thus, gradient 
matrix C has the dimension 32 x 6 (32 measurement data x 6 degrees of freedom). Thus, 
for each of the intermediate positions to be controlled in closed loop, one obtains a setpoint 
measurement vector y setpoint and gradient matrix C. 

[0061] In a third operating state, the so-called operation mode, manipulator 2 travels the 
traverse path from point A to point C under control of the closed-loop control program. When 
the traverse path has reached point C, the closed-loop control program is invoked, and the 
open-loop control program cedes control of manipulator 2 to the closed-loop control program. 
The closed-loop control program travels the stored traverse path between points C and D. The 
stored points of the traverse path permit a predictive control of the intermediate positions on 
the traverse path, which, given the same or even greater precision, renders possible a 
substantially higher traverse-path velocity than do related-art methods for controlling the 
intermediate position of a manipulator. 
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[0062] Located in the area of the traverse path between points E and F is a region of 
interest for the closed-loop control that includes one or more intermediate positions of 
manipulator 2, which are to be controlled in closed-loop relative to object 3. As soon as the 
traverse path reaches point E, the intermediate position is controlled in closed loop on the 
traverse path. In the course of the closed-loop control of the intermediate position, the 
corresponding values of the measurement data are initially recorded by sensors 9 in the 
instantaneous actual intermediate position and stored in an actual measurement vector 
yactual. The actual measurement vector yactual likewise has the dimension 32 x 1 (32 
measurement data x 1 value). From the difference between the setpoint measurement vector 
and the actual measurement vector, a differential measurement vector D_y is formed (D_y = 
y setpoint - y_actual). Differential measurement vector D_y likewise has the dimension 32 x 
1. The inverse value of gradient matrix C is then computed and optionally stored. From the 
product of the inverse value of gradient vector C and of differential measurement vector D_y, 
a correction vector D_x is ascertained, which likewise has the dimension 32 x 1. It is also 
conceivable, however, for correction vector D_x to be ascertained using another suitable 
method, for example by employing a sequential Kalman filter. 

[0063] A portion of correction vector Djc, preferably about 10% of correction vector 
D_x, is used for correcting the actual intermediate position of manipulator 2. In the new 
actual intermediate position, the corresponding values of the measurement data are once again 
recorded and stored in an actual measurement vector y actual. As already described above, a 
correction vector D_x is once again computed, and the actual intermediate position is 
corrected as a function of correction vector Djc. The process of correcting the actual 
intermediate position is repeated until the individual values of correction vector D_x have 
fulfilled a specific abort criterion, i.e., until manipulator 2 is controlled in closed loop to 
the setpoint intermediate position. 
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WHAT IS CLAIMED IS: 



1 . A method for controlling the intermediate position of a manipulator (2) of a handling 
device (1) that is movable in a plurality of degrees of freedom, relative to an object (3) 
along a traverse path, 

wherein a plurality of points of at least one portion of the actual traverse path are 
stored and are consulted for a predictive control of the intermediate position of the 
manipulator (2) along this portion of the traverse path. 

2. The method as recited in claim 1, 

wherein the actual traverse path of the manipulator (2) is traveled prior to the process 
of controlling the intermediate position and, in the process, the points of at least one 
portion of the actual traverse path are recorded and stored. 

3. The method as recited in claim 2, 

wherein the actual traverse path is traveled by the manipulator (2) in a controlled 
process before the intermediate position is controlled by an internal open-loop control 
device (6) of the handling device (1). 

4. The method as recited in claim 2 or 3, 

wherein the points of at least one portion of the actual traverse path are recorded and 
stored by an external closed-loop control device (7). 

5. The method as recited in claims 3 and 4, 

wherein the external closed-loop control device (7) is invoked by the internal open- 
loop control device (6). 

6. The method for controlling the intermediate position of a manipulator (2) of a 
handling device (1) that is movable in a plurality of degrees of freedom, relative to an 
object (3) along a traverse path, in particular as recited in one of claims 1 through 5, 
wherein, prior to control of the intermediate position, the setpoint intermediate 
position of the manipulator (2) is approached, while the setpoint intermediate position 
is changed in each instance by one degree of freedom; measurement data 
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characterizing the intermediate position of the manipulator (2) are collected and 
stored; and the intermediate position is controlled as a function of the measurement 
data. 

7. The method as recited in claim 6, 

wherein, prior to the control of the intermediate position: 

- the setpoint intermediate position is approached; 

- a setpoint measurement vector (y setpoint) is recorded using the measurement data; 

- for each degree of freedom, the manipulator (2) of handling device (1) is moved out 
of the setpoint intermediate position into a plurality of intermediate positions, and a 
measurement vector is recorded in each intermediate position; 

- for each degree of freedom, the absolute value of the gradient is determined for the 
same measurement data of the measurement vectors and is stored in a gradient matrix 
(C), and, in the course of the control of the intermediate position, 

- a correction vector (D_x) is determined by multiplying the inverse value of the 
gradient matrix (C) by the difference between the setpoint measurement vector 
(y_setpoint) and an actual measurement vector (y actual) in the actual intermediate 
position of the manipulator (2) or on the basis of another suitable method; and 

- the intermediate position is controlled as a function of the correction vector (D_x). 

8. The method as recited in claim 7, 

wherein the actual intermediate position of the manipulator (2) is corrected in the 
course of the control of the intermediate position by a fraction of the correction vector 
(D_x), and the actual measurement vector (y_actual) in the corrected actual 
intermediate position and the correction vector (D_x) derived therefrom, are 
ascertained once more. 

9. The method as recited in claim 8, 

wherein the control of the intermediate position is discontinued when each of the 
elements of the correction vector (D_x) is smaller than an abort criterion. 

10. The method as recited in claim 8 or 9, 

wherein, for each degree of freedom, at least two measurement vectors are recorded in 

19 



each direction, from the setpoint intermediate position. 



1 1 . The method as recited in claim 1 0, 

wherein, for each degree of freedom, five measurement vectors are recorded in each 
direction, from the setpoint intermediate position. 

12. The method as recited in one of claims 1 through 5, 

wherein, together, the measurement vectors contain at least six measurement data, in 
order that the position and orientation of the manipulator (2) relative to the object (3) 
be characterized in three-dimensional space. 

1 3 . The method as recited in claim 1 2, 

wherein the measurement vectors each contain 32 measurement data. 

14. A device for controlling the intermediate position of a manipulator (2) of a handling 
device (1) that is movable in a plurality of degress of freedom, relative to an object (3) 
along a traverse path, 

wherein the device includes means for implementing the method as recited in one of 
the claims 1 through 13. 

15. A handling device (1 ) having a manipulator (2) that is movable in a plurality of 
degrees of freedom and whose intermediate position relative to an object (3) is 
controllable, 

wherein the handling device (9) includes means for implementing the method as 
recited in one of the claims 1 through 13. 

16. The handling device (1) as recited in claim 15, 

wherein at least one sensor (9) is affixed to the manipulator (2) of the handling device 
(1) to ascertain the actual intermediate position of the manipulator (2) relative to the 
object (3). 

17. The handling device (1) as recited in claim 16, 

wherein the or each sensor (9) is positioned relative to the object (3) in such a way 
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that the sequence of the measurement data of the measurement vectors recorded for 
one degree of freedom is strictly mono tonic. 

The handling device (1) as recited in claim 17, 

wherein one absolute gradient value is contained in the gradient matrix (C) for each 
degree of freedom, in each instance for at least one recorded measurement datum. 

The handling device (1) as recited in claim 18, 

wherein the absolute gradient values in the gradient matrix (C) are significant. 

The handling device (1) as recited in one of claims 15 through 19, 
wherein the or each sensor (9) is designed as an optical sensor. 

The handling device (1) as recited in claim 20, 

wherein the or each sensor (9) is designed as a CCD camera. 
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ABSTRACT 



A method for controlling the intermediate position of a manipulator (2) of a handling device 
(1) that is movable in a plurality of degrees of freedom, relative to an object (3) along a 
traverse path. To make possible a more rapid control of the intermediate position, it is 
provided for a plurality of points of at least one portion of the actual traverse path to be stored 
and for a predictive control of the intermediate position of the manipulator (2) along this 
portion of the traverse path to be consulted. 
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